An Automated Method of Tuning an Attitude 


Estimator 


by 




N95- 27774 


Paul A.C. Mason 1 and D. Joseph Mook* 


Abstract 

Attitude determination is a major element of 
the operation and maintenance of a spacecraft. 
There are several existing methods of determining 
the attitude of a spacecraft. One of the most 
commonly used methods utilizes the Kalman filter 
to estimate the attitude of the spacecraft. 

Given an accurate model of a system and 
adequate observations, a Kalman filter can 
produce accurate estimates of the attitude. If the 
system model, filter parameters, or observations 
are inaccurate, the attitude estimates may be 
degraded. Therefore, it is advantageous to 
develop a method of automatically tuning the 
Kalman filter to produce the accurate estimates. 

In this paper, a three-axis attitude 
determination Kalman filter, which uses only 
magnetometer measurements, is developed and 
tested using real data. The appropriate filter 
parameters are found via the Process Noise 
Covariance Estimator (PNCE). The PNCE 
provides an optimal criterion for determining the 
best filter parameters. 

Introduction 

The development of light-weight, low-cost 
spacecrafts that can accomplish complex tasks is 
essential to the success of many NASA missions 
(such as Mission to Planet Earth) as well as the 
success of many commercial missions. One way 
to ensure a light-weight, low-cost spacecraft is to 
place constraints on the amount of computer 
hardware. This constraint demands the use of 
computationally efficient algorithms that do not 
require a significant amount of CPU. 
Consequently, reducing the amount of required 
hardware improves the performance of the 
spacecraft and increases the probability of a 
success. 

One of the many functions of a satellite is the 
gathering and processing of information. In most 
cases, this information is transmitted to a specified 
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location. To successfully complete this objective, 
the orientation of the spacecraft must be known 
and controlled very precisely. In the past decade, 
there has been a significant amount of work in the 
area of attitude determination and attitude control 
[1-5]. During this period of time, attitude 
determination algorithms that utilize a 
combination of the measurements and a 
mathematical model to estimate the orientation of 
the spacecraft [6-7] were the most popular. One of 
the most commonly used and most robust 
estimators in attitude determination is the Kalman 
filter. The complexity of this estimator ranges 
from attitude-only estimator using a QUEST 
model to an extended Kalman filter with 36 states 
[ 8 ]. 

Attitude estimators like the Kalman filter are 
more robust than single-frame methods, such as 
TRIAD [2], QUEST [4], and FOAM [3]. For 
example, during periods of near coalignment (the 
pitch angle is nearly unobservable) or during an 
eclipse, a sequential estimator, such as the Kalman 
filter, can provide state estimates by propagating 
the states with the nominal model. Single-frame 
methods that rely on measurements can only 
produce anomalous estimates of the attitude. 
These estimates may endanger the success of the 
mission. 

The most difficult filter parameter to 
determine in the Kalman filter is the process noise 
covariance, Q. In theory, the process noise is 
defined as a gaussian process. In real-world 
applications, the model error can be stochastic, 
deterministic, or a combination of both. Since the 
attitude determination problem is very nonlinear, 
there is a larger possibility for errors in the system 
model. These errors, along with any stochastic 
errors, are referred to as modeling errors. As the 
percentage of non-gaussian modeling errors 
increases, so does the difficulty in determining an 
appropriate process noise covariance. Therefore, 
it is beneficial to develop an algorithm that 
produces the filter parameters which yield accurate 
state estimates. In this paper, the PNCE, an 
algorithm that determines the appropriate filter 
parameters, is applied to attitude determination. 
This method provides an automated method of 
tuning the estimator to obtain reasonable state 
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estimates without prior knowledge of the process 
noise covariance. The PNCE allows for the 
implementation of Kalman filter type algorithms 
in real-world applications where the true or the 
appropriate process noise covariance is not known. 

If a spacecraft has rate sensing capability, then 
the attitude estimation is generally improved over 
non-rate sensing capable spacecraft. When this 
capability is not available, the attitude estimation 
can be improved by estimating the rates based on a 
model of the spacecraft rotational dynamics. The 
Solar Anomalous and Magnetospheric Particle 
Explorer (SAMPEX) [9] and Earth Radiation 
Budget Satellite (ERBS) [10] are two such 
spacecraft that do not have rate sensing 
capabilities. In the case of SAMPEX and ERBS, 
accurate attitude estimates are ensured by 
estimating the rates that are based on simple 
rotational dynamic models along with the attitude. 
These rotational models improve the overall 
estimation of the attitude. However, there is no 
general model for rotational dynamics. 

In 1990, Chu and Harvey showed that models 
of the rotational dynamics could be identified [10- 
11] and that these models improved the overall 
estimation of the attitudes. However, obtaining 
these models can be time-consuming, and the 
models are only valid for the identified orbit. In 
1993, Mook [12-13] described a numerical 
procedure of finding the appropriate dynamic 
model of the rates. This procedure can produce 
models that are valid over a duration longer than 
the orbit used in the identification. Consequently, 
this method can be used in prediction. This 
method is new and has not been applied to many 
spacecraft. Hence, there is still a need for a simple 
general model of the rotational dynamics. 

To circumvent this problem of not having an 
accurate dynamic model, a commonly used gyro 
bias model, based on a Markov process, is used in 
place of complicated, difficult to obtain rotational 
dynamic models. This type of simple bias model 
has been successfully used in the Real-Time 
Sequential Filter (RTSF) [9]. RTSF uses the gyro 
bias model along with the basic theory of attitude 
determination to produce accurate attitude 
estimates. The accuracy of the estimates from 
RTSF are dependent on certain filter parameters. 
In many applications, the RTSF may require a 
manual tuning. The complexity of this task is a 
function of the known and unknown dynamics of a 
spacecraft. 

The rest of this paper is divided into three 
parts Theory, Results, and Conclusion. The 


theory section reviews the formulation of the 
attitude estimator and the PNCE. The result 
section starts with a definition of the problem and 
the given filter parameters. Next, these parameters 
are used along with the PNCE to obtain accurate 
attitude estimates. The conclusion section 
summarizes the results and states a few 
observations. 

Theory 

With few exceptions, the dynamics of a 
spacecraft can be described in terms of classic 
mechanics. The dynamics of a spacecraft are a 
function of its orbit and attitude. In this work, 
only the dynamics associated with the attitude are 
addressed. The first step in this analysis is the 
definition of the attitude. 

Attitude Determination: Definition 

The attitude of a spacecraft is defined as its 
orientation. Attitude determination is the process 
of computing the orientation of the spacecraft 
relative to either an inertial reference or some 
object of interest, such as the earth. The attitude 
determination problem can be stated as: ’’Given 
measurements of angles or changes in angles with 
respect to the spacecraft and a reference, 
determine the orientation of the spacecraft.” 

Attitude measurements are produced by 
sensor such as Fine Sun Sensors (FSS), Three Axis 
Magnetometers (TAM) sensor, Horizon sensors, 
Star Trackers, etc. FSS and TAM measurements 
are used by algorithms like TRIAD [2], QUEST 
[4], FOAM [3], and the Kalman filter [5,14] to 
determine the orientation of the spacecraft. The 
accuracy of the attitude is a function of the sensors 
and the attitude determination algorithm. Attitude 
estimators use a combination of several attitude 
sensor measurements, which are usually associated 
with the three-axis attitude, to improve the 
reliability and accuracy of the algorithm. 

Three-axis attitude is most conveniently 
thought of as a coordinate transformation from a 
reference axis in inertial space to an axis on the 
spacecraft. For a rigid body, or assumed rigid 
body spacecraft, the direction of cosine matrix or 
attitude matrix, A , represents the coordinate 
transformation that maps vectors from the 
reference frame to the body frame. This 
transformation can be described as 
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where e b<xfy an d e re/ have components resolved 
along the body and reference axes, respectively. 
The attitude matrix consists of three orthogonal, 
right-handed triads u, v,w unit vectors fixed in 
the body, such that 

ixv = w (2) 

Hence, if one can specify the components of u , 
V , and w along the three axes of the coordinate 
frame, then the orientation can be determined 
completely. 

The attitude matrix is a real orthogonal matrix 
that has many different orientation 
parameterizations. The type of parameterization 
used is dependent on the application. A 
commonly used parameterization is the Euler 
parameterization (Euler angles). On of the 
benefits of using this type of parameterization is 
that the Euler angles have some physical 
significance Another type of parameterizations is 
the quaternions parameterization, which is also 
known as the Euler symmetric parameterization. 

Quaternion Parameterization 

The term quaternion, which is sometimes 
referred to as Euler symmetric parameters, was 
first used by Hamilton [15] in 1843. 

Many authors [16-20] have discussed the use 
of this four-parameter representation of the 
attitude. The advantage of using quaternions over 
Euler angles is that quaternions are not singular, 
unlike Euler angles. Because of its advantage, 
today, most attitude estimators utilize quaternion 
attitude representation instead of Euler angles. 
Quaternions are also easier to work with. 
However, the quaternions representation is not 
unique. This characteristic is discussed later in the 
text. The quaternions are defined by three primary 
parameters and an auxiliary parameter 

[<1. q, q,] = esin(f) 

q 4 = cos(f) (3) 

where: 

e is a unit vector corresponding to the 
axis or rotation 
<£> is the angle of rotation 
The quaternion parameterization is nonsingular 
because the quaternions are not independent. The 
quaternions are related by the following 
normalization constraint 

ft + ft + ft + ft = 1 (4) 


Quaternions can be defined in terms of the attitude 
matrix or the Euler angles. The reverse is also 
true, that the attitude matrix can be expressed in 
terms of the quaternions 
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(5) 


4<7) = (< 7 4 2 -q 2 )l+2qq T -2 q t Q (6) 

Being able to represent the attitude matrix as an 
algebraic function of the quaternions is another 
computational advantage of the quaternion 
representation. Now that the quaternions 
representation and the attitude matrix have been 
defined, the kinematics of the orientations and 
dynamic equations of motion can be addressed. 

Kinematics and Dynamic equations of 
motion 

Kinematics is the study of the orientation of 
the object rotating (with its body axis fixed on the 
body of the object) relative to some global frame 
of reference, which results in equations of motion 
of the orientation. These equations of motion are 
independent of the forces associated with the 
particular problem. 

As defined in the literature, the kinematics 
relation for the orientation is 


q = \Cl{w)q 


(7) 


where the expression Q of a variable a can be 
represented as 
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then Q(a)9 = 9<8>a, where quaternion 
multiplication, q t <8) q vV is defined as 
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The attitude dynamic equations of motion, 
relating the time derivative of the angular 
momentum and the applied torque, is 



w x L - 


dw 
I — 
dt 


where N is the torque vector 


(9) 


N = x F f 00) 

i si 

F is an external force. A spacecraft equipped with 
reaction or momentum wheels is not considered a 
rigid body. Therefore, the attitude dynamics 
equation must be modified 

— = N -\r'(L- h)]xL= I — ’ (11) 

dt L dt 

The body angular rates associated with this system 
are defined as 


w=r\L-h) ( 12 ) 

The difference between the true quaternion 
and the estimated quaternion is 

q = q t ^ 0 dq (13) 

where q is the estimated quaternion and 5 q is the 
difference between the estimated and actual 
quaternion. Substituting this into the dynamic 
equation for the estimate (7) yields 

-(?« ® 8?) = f 00)(<7,„ ® 5q) 

dt 

d&q , „ _ „ 

\q„„ ® < 8 >&q + ® — — = \q r „ ® 89 ® w 

dt 

2 — = bq 1 ® w - <8> 8^ (14) 

dt 

Note, hq is unique because it is defined as 
5q = [a if (15) 


x(t) = 


<7(0 

MO. 


The dynamic equations are 


q = 7 Q(M)q 


dl r w o dw 

— - /V - | / (L - h)\xL = 1 — 
dt 1 J dt 

where the body angular are 


(16) 


(17) 

(18) 


w=l\L-h) (19) 

N is defined by equation (10). The state space 
representation is 


dX 

'}Q(w) 
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( 20 ) 


— = f(w)X + BN (21) 

dt 

For nonlinear systems, the error analysis is 
based on a linearization of the system. Defining 

3f . 

F = — , the error covariance can be written as 

ax 

dP 

— = FP + PF l + Q (22) 

dt 

Update equations 

The update equations for this filter formulation are 
the same as in the RTSF [21] formulation 

y =[K fl x]tt(-) + AK b (23) 

The sensitivity matrix H can be defined as 

H = Of, *] 0,.,] ( 24 ) 

Consequently, y is linearly related to the state error 
y = Hx(-) + AV b (25) 


Propagation equations 

In this section, the estimation algorithm is 
formulated using the same filter formulation 
presented as Mook [12-13]. This formulation is 
mathematically rigorous and produces accurate 
estimates. 

The propagation equations are based on the 
equations of motion. The seventh order state 
vector for this filter is 


The update equations are 
1 = Ax = Ky 


bq = 


a* 

1 


(26) 


(27) 
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q* = q ( 8) 5 q 

(28) 

L = L + 5 L 


P + = [I -KH]P 

(29) 

K = P H t [H P H + R] ' 

(30) 


Summary of algorithm 

To summarize this algorithm, consider the 
following steps taken during the execution of the 
filter. It is assumed that all filter parameters are 
known ahead of time. 

Given 

• The initial attitude quaternion <?*(+) 

• The initial rate error Z A (+) 

• The initial error covariance P k (+) 

1. Propagate the states and error covariance 
using the updated or initial values of the 
state and the error. ( 1 7) and ( 1 8) 

2. Compute the residual. (23) 

3. Compute the update state, update 
covariance and Kalman gain. (26-30) 

4. Go to 1 

In the filter formulation above, the process 
noise is assumed to be a known gaussian process. 
For real-world application, the process noise is not 
known exactly. Therefore, the next logical step is 
to devise an algorithm that produces the 
appropriate covariance to produce accurate state 
estimates. The method used in this paper is 
referred to as the PNCE . 


covariance matrix. The major steps of the PNCE 
are given below: 

1) Use Q i in the Kalman-type filter to 
calculate the state estimates. 

a) For the initial step, Q x is an initial 
covariance provided by the user. 

2) The state estimates are used to evaluate the 
costs and constraints in the cost/constraint 
routine. 

3) If the cost is not minimized or the 
constraints not satisfied, then the 
optimization routine calculates a new Q x 
and return to step 1. If the costs are 
minimized and the constraints are satisfied, 
then the appropriate process noise 
covariance is found and PNCE stops. 

PNCE 
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Figure 1 Flow chart of the PNCE algorithm 


PNCE 

The PNCE [21] is a parameter optimization 
technique that identifies filter parameters that 
produce near-optimal state estimates in the 
presence of model error. This algorithm can be 
thought of as an external optimality criterion for 
obtaining filter parameters, in particular the 
process noise covariance, Q. In the formulation 
presented here, the process noise covariance 
matrix is assumed diagonal. This diagonal form 
simplifies the optimization and is frequently used 
in research and applications. The accuracy of the 
PNCE algorithm is a function of the optimization 
process and the complexity of the functional form 
of process noise covariance. 

Figure 1 contains a flow chart of the PNCE 
algorithm. The flow chart describes the steps 
taken by the PNCE to solve for the appropriate 


There are several advantages to this 
algorithm. First, it provides a consistent method 
of determining the appropriate process noise 
covariance. Another advantage is that the physical 
model error does not have to be a gaussian process 
to obtain accurate results. The physical model 
error is the model error associated with real-world 
applications. This error is not confined to gaussian 
process as defined in the original Kalman filter 
formulation. This allows the filter to be 
implemented in non-ideal environments, such as in 
real-world applications. 

As shown in Figure 1, the PNCE is made up 
of several different components. The most 
important of these components is the 
cost/constraint routine. 

Cost/Constraint Routine 
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In this section, the cost/constraint component 
of the PNCE is discussed. The cost/constraint 
routine is the second component of the PNCE 
algorithm. This component defines the accuracy 
of the estimate of the filter parameter estimation. 
This component is user and problem dependent. 

Covariance Constraint 

A major part of the cost/constraint routine is 
the Covariance Constraint. The covariance 
constraint was formulated by Mook and Junkins in 
1985 [23]. This concept was developed as a part 
of another estimation algorithm, the Minimum 
Model Error algorithm. The covariance constraint 
states that the measurement-minus-estimate error 
covariance must match the measurement-minus- 
truth error covariance if the estimates mirror the 
truth. When this occurs the covariance constraint 
is satisfied. In the PNCE, the covariance 
constraint is a function of the process noise 
covariance, Q. The correct Q should produce 
estimates that fit the actual measurements with 
approximately the same error covariance as the 
actual measurement fit the truth. Therefor, the 
measurement noise distribution does not have to 
be completely gaussian to obtain accurate 
estimates. The covariance constraint can be 
expressed mathematically as: 

£[(?-O r (?-i>)]= R (3i) 

where: 

R (w x m) is the measurement noise 
covariance 

y (m x l) is the measurement vector 
y(t) is the output estimate vector 

The covariance constraint is the primary cost 
function used by the PNCE. However, other costs 
functions and constraints can be utilized to 
improve the results of the parameter identification. 
These additional functions and constraints, if used, 
are dependent on the application. 

Simulation Results 

In this section, the PNCE algorithm is used to 
develop an accurate attitude determination 
estimator based on real data. This data is obtained 
from telemetry files provided by NASA Goddard 
Space Flight Center, Flight Dynamics Branch. 
These telemetry files contained a nominal pass 
(nonevent) data set. A nonevent data set is used to 
ensure that the "truth” (from TRIAD) is available 
to evaluate the performance of the filter. 


To maintain consistency, the same numerical 
values of the filter parameter used in the RTSF 
report [27] are used here. The inertia matrix, /, 
and the wheel inertial, I whl , are 



I wM = 0.0041488 kg-m 2 

The total torque vector, A, and the angular 
momentum, /?, are known inputs to the system. In 
this simulation study, the measurement noise 
covariance is obtained from the SAMPEX 
evaluation report [21]. 

For the Fine Sun Sensors (FSS) 
measurements, <T 2 VV = 6.346 x 1CT 6 . The error 
in the FSS measurement is primarily due to the 
digitization noise (0.5 deg). For the TAM 
measurements, the digitization noise is only about 

0.3 mG and <j\ AM — 3 mG. The time constant 
used in the gyro bias model is x = 5.0 sec (for 
playback). A distinctive feature of telemeter 
SAMPEX data is the large amount of white noise 
associated with the torques. The magnitude of the 

torques associated with this noise is I0~ 2 , which 
far exceeds the magnitude of the environmental 
torques of 10 6 . 

The noise statistics, along with physical 
insight, are used to determine the growth rate of 
the error covariance. The growth rate is 


rad ' 

(3*10 )A/ 


This is an approximation of the process noise 
covariance, Q . Using this approximation, physical 
insight and tuning, the appropriate Q can be found, 
but this process can be time-consuming. In this 
experiment, an automated method of tuning the 
estimator, the PNCE, is used to determine the 
appropriate filter parameter. 

Since the attitude estimator developed here 
only requires magnetometer data, some of the 
accuracy and reliability may be lost. This 
simulation is used to demonstrate that an accurate 
estimator can be developed automatically. To 
ensure robustness in the presence of additional 
modeling errors, the initial conditions are 
perturbed from their correct values. 
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For this study, the process noise covariance is 
assumed to be of the following form 


' L 0 A.aJ 

where q and q t are to be determined. Using the 
measurement noise, the PNCE determines the 
appropriate values for q tf and q L . 

q q = l.e-2 q, = 9Me - 8 

During non-event passes, good data from both 
FSS and TAM, TRIAD is considered to be near- 
perfect. Therefore, TRIAD is considered to be the 
Truth. A nonevent pass is part of an orbit or the 
whole orbit where an eclipse or other anomalies do 
not occur. 

Figure 2-4 contain plots of the Roll, Pitch, and 
Yaw of the truth and of the estimator using the 
standard formulation. The state estimates are 
initially off but then converge to the truth quickly. 
This initial error is due to the initial condition 
error. Figure 5 contains a plot of the output 
estimates and the TAM measurement. 


Formulation 1 Filter vs the Truth (TRIAD) 



Filter (First Formulation) vs the Truth (TRIAD) 



Figure 3 The estimated and true Roll 


Filter (First Formulation) vs the Truth (TRIAD) 



Figure 4. The estimated and true Y aw 


Figure 2 The estimated and true Pitch 
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Figure 5 The TAM measurements and the output 
estimates 

In the plots above, filter produce accurate 
estimates of the attitude and the output (the TAM 
measurements). Even though the initial conditions 
are perturbed, the filter is able to converge to the 
truth quickly. This illustrates the robustness of the 
PNCE and the present filter formulation. 

Conclusion 

The purpose of this paper is to demonstrate a 
new method for obtaining accurate state estimates 
for a three-axis magnetometer attitude estimator. 
This method, the PNCE, used statistical properties 
and a data set to determine the appropriate process 
noise covariance. The PNCE algorithm is utilized 
to develop an attitude filter. This filter 
formulations produced accurate attitude and output 
estimates. 

From the results in this paper, it has been 
shown that the PNCE estimator is a robust 
algorithm that can account for deterministic linear 
model uncertainty and error in the initial 
conditions or the filter parameters. 
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